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(54) ROBOT HAND POSITION MEASURING DEVICE 

(57)Abstract: 

PROBLEM TO BE SOLVED: To improve the position 
measuring accuracy of a robot hand. 
SOLUTION: A spot light source installed at the tip of a 
robot hand is photographed with a pair of read binoculars 
installed in difference places from each other so that it 
can change the image pickup directions of the read 
binoculars, respectively, along azimuth and elevation 
directions. The image pickup direction of each read 
binoculars is changed along the azimuth and elevation 
directions so that the center of gravity of the spot light 
source area in the image obtained by image pickup can 
agree with the center of the image (so that the image 
pickup direction can agree with the spot light source 
direction). When these centers agree with each other, 
three-dimension coordinates at the tip of the robot hand 
is calculated from the azimuth and elevation directions. 
When the center of gravity disagree with the center of 
the image as (A) shows, the value of the angle at the 
time of the image pickup direction agreeing with the 

direction of the spot light source is calculated by interpolation as (B) shows. 
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[0 0 8 21 z(D^^mm^mm^mc mi <ou 

^t. ^<D:^Ty^2 0 4X\t. y 2 0 2 (D ^.it 

mm^mm^m\z ^ o xn hi\.tz.^^n mm^^ o(Dt^ 

[0 0 8 3] lfiZ(D>^'ryZf2 0SX\±. ^—^yVM.^ 

t). 'm2<om^m^m,A2(r>m^'^^t^^-^yvf^.% 
So j^^mm^mm^mffmT't^t. ^<oy^=ry^2 

0 8 -Cli. X :y :/ 2 0 6 (50;^^j^^il£^iJtai^atc i; o 

T4te>ix/c;&{i:ftiiMA50 <^ t ^6o;^ja^^ge 

^{Hll;65 0(O<b^<7)ffll:^1S*SrW^i*2 2 t>#M) 
[O0 8 4] •=E-bT;?^7"5'7'2 1 0-Cii. _hSa«!.SIJcJ: 

(X, Y. Z) ?:^3^^i;itJto-Ci^^i-6, 
X — (L- tan0 2^ / (tanfli+tanflg) 
Y = X*tan0i Z=y" (X=^H-Y^) • t a n 

1 

^j^^fi (X, Y, Z) ^iSttS{-*i?>5r 



ItSa^Ky K2 Og^comgimt XYZ|fe>^J^«i 

[0085] «^f^<Ot+SiH4gt^i^At)^^:^i6^tl.Ti3 
^(D:^ir y:r2 1 2T'f±. (Off j|iHa[g|COl>T 

>^2 0 OICMO. ^v^?^:/2 0 O^^^r 
M^Oig-To ikr<Z)|fift[fiE:glc:MUr:?^7^'y7'2 0 0-2 
1 0<O*«.a^tT9 y^y'y^2\ 2(On^t^1^'^^i^. 

xitLm-VcmmM^f^T-r^o 

[0 0 8 61 ±J^ U^cf^H - *0!»C J: 9 , P;Kiyh^^> 
K2 0 O^Mx K 2 8 Oi^fftpT^gSPalF^^^^aiS^^fi-afii^ 

<0»1&@S&©S:X YZ«MM«^fcJott6M«11^ b 

8 S: < ^ n -5 ^ ^ /j: So 
[0 0 8 71 ^fc. 1 IIJfe?g^<i-CJi, fg logins 

]^^4 0. ^2 0^^g^^4 2 2!jS;^7"— v^a 2 A, 3 

O. 4 2S:'&tfa7K5/ WiMlfSy^Ml O^^g 
-rs^46J::igi.§g|nc;5^-<— «r/^$ < -TS :Ltt^X^ So 

[0 0 8 8] ^/-c. l^^lM3S^4 0. 4 2^^tf07Ky 

f^ojK^/ h^NV K2 oc^ggs^gaff^d^^is^^-f-s::^ 
g^^^Tv^Sl^<?>4/t^fttd*5^^X. (oui^^y 

2Q\ZS^^\^Xy^T—i^3 2(0^^^nXiS\^tl. ^— 

^>VK2 OT^^rSwt t>^|g^^rf:So 

[0 0 8 9] ^4b\ iMxvmmi^<D^^-'^^t\^x 

^Jc:J:S^#;d^^m-e^?^i:ir^^;>cti^^o^f;^li. ^ 
1 <^S^^IIit« 4 0 IkXim 2 <OBgliMitM«-+iS 

[0 0 9 0] :^yc^ :*=^lllSfe?^^icioV^T. .'^3tt!^.fi 

S (ri^lc#or&ath«»J«iWc:fcJtS<£effh»J«JSf^ 

mmm s:^^<gjeA±^i-s) 7tAt)(c. «i^$tbspf® 

crsjf?' h^>:/K2 0<5D/N^^K2 8<05fe 

:yx^X'~'j^u>xxm^\.. ^.fm,mm\m^m(D:^ 
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10 0 9 11 X— A l/vXcoX— Aft^ 

^jE-r-si:, wvx<D^tt«t^H:.^7ii-rn6c^-cit^i^7- 

rigs (A) (c^i-i: 9f-M^4'coA^MM^<7)fi.6{i 

a;6^a£^b-r-5«??T% ffsyitso^sTi-jgA^So core 

J&lT(7)#flR"^X— AW'VXo3fc*Ai'n«:«jEi-5C 

lO 0 9 21 -fir*?^. *i*n i^J^y h^Ni/ OO^^^' 
«§«t::ta^) m-<O^ISF^O#{im$:sE6-^oX 

v^Tw>'X(7^3fe«l13.c^^c:5l^^£;i-a««ffi^^^^S 

[0 0 9 3] ^UT, ;St3fei8^tflE*Ji»ft!;SJ-*5V^Tfi, 
^^^yXl 5 0T-M$£MlfefO;^^a^.O|5rtT?gmtC^c;:i:.T 
X— A I^VX<7)X— Afi^SJE UfcifeiC, ^31&(7)X- 

<o^%m^^^im>^. X— Au>'X<:o3t«li 

M^tf pri!~T?, ^X-iKfilic:^^tt6ii»4^'6^:^i?)T 
t>J:v^ Cio::^&T'fi. ^i^)^— oX— J^^i:^cov^T^Q 

iyX2 5 0) . s£^bfc^^E<OX-AttJC^/t>i-^m 

^«to fi^L- r> ^^<D X— ^ td It 6 tc- ffc-r 

[O 0 9 51 JJttCl. ;fe^j^O^S«r@^Ufc**-eX- 
A|g^a5H*t"'5 (>^7^i/X2 5 6) o r<:o^^<7)X-A 



(>^-7">yX2 6 0) o r.<0-rjxl[{i. -:^Xj/r2 5 8{C 

ib'it^X— X-A 1/ vXc>3tW4g(0 

[0 O 9 6 J ftfe<?5X-ix||[ScjoJta»m+'L^«r^«>-5# 

^>/X2 5 2lCMt). ;^^5'X2 5 6T^:gLyc:m?5E<7)X 
;^7^yX2 5 4i^l^O^$rii^t)ig'ro ±IE.<:0^^ 

10 0 9 71 [II 2 mMMm'] m^^mm<o^ 2 ^jg?!^ 
g 6 0 fi, Ml mmf^mxmm t yt^^^^^^ 40,4 

2tcR;tr. X$|&fii«t^g6 2. Y<^Ji^g6 4. X 

(0 0 9 8] glio (B) *c:^i-J:9i:i. xWiiftSSM 

6 2 W:Rl^tftOil^lHl|fP6 2A^{jS;tT:|of?. liSElBllfP 6 2 

Ao$4^^»5 (P:^0:^f^) tcieiSi^tgi-^ape 2 etc 

l$&Q^b^@ll^ii^i%4 0. 4 2^P^(C. j^(»I^6 2A 

^{[n:^;^f^(ciE]i<}^it^P:^;^r^JS2ib^4 8^. 

6 2 A<^itp:^:^lPlcOlE]Kj^g^«r«^W'r 5 O 

10099] laio (A) (w^^iptd, XI4:^7^— 

6 6^U^Yiay^X"^?6 8 fl. iiE^CO^^^^lCi^lFe 7 
0;55ft{^tt<btLT*>*3 . g?P^¥E3 Ofctt, t^m^7 

OlC^^&UX;^^^— 2 2&5^|S[tSJt^iXTl^-5o XHa 
6^t^Y$A^'r":;^6 811. ^^[(01^1$ 7 0 

[Olool x^:^T—i^ee{a^, jKEIHSBe 2 Ao$ft 

6 2d51lf^tte>ixr:fc«). Xtttilfei^ga 2Jil^-/KO 
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kcm^x^th^^^xVi:t\pi}mWi%7 2 v—/KD5ffi 

1 0 1 0 1 1 xm:^\^mwiM 7 2 fi, mi mi^mwixm 
ii^^cD^m m\^<u.^uo^m^m.tx^WLm.^m.e2 

Iglfei^g 6 4 $r i^-/Wci?ao T^ib Y«A:^[RjS2gi 
B 7 6 ^ . I— /KD5£tS!:^I^jC?&o YttStfe^lB 6 4 

o^jg (Y^;^f^s]{4ia) $r^iti-r6Y#{ig^fcti^7 8 
=Sr^i^Tv^So ^£*3. Ytt;^^s^l^i^»^$7 6jix<i;^fpjl^ 

7 2t m^^m^x^ y> . y wig^^a^ 7 s jix 

[0 10 31 xttlftfik^ae 23S:t;^YlA»tfe^S 

^A<r>m^ns mui^xy^^ik:^^m.w\nAs x^x 

t). flIl:ft^WSB5 0. Xtt^©^ffl^7 4At/Y$fi^a 

[0 10 41 ^mz^mmMx^n. xYxm^mmnt 

spffis 0±<o-^{ig(c^jl^nfc4^^'C. x«;^x- 
Y«. l^^^3l•3l&^i:^^Rl^c^&ofc«l^z*l|^:-r^xY 

Ytt^r^^^-f-axtt:^^"— i^e 6. Ytt>^-7^— ::^6 8. 

Xl4ii^§gm6 2^5Lt5Ytt^g^^6 4;^i5^4?)-'«^icm 

$tt^x«*ifiifijrB:RtfYtt^aiftaa5 7 8{cj:ox«^ 



W ^ Y X Y z ic^t;^: ^ 5 

W ^ix^ W:^^ ^mM^ X Y Z tc^^t: ^ Its 

(0 10 61 xijftm^ge 2l^ti^l^^X$& 

HY«i;^i^<Sig) *50tfoi:#(DXtt;^r^f4^x OLVtY 

[0 10 7] xMmmmm.^ 2 (x*tY^jt 

^^6 4) <D«^i6i;55;^±2i {mmwL^m.^%ms 

4X*±i5'— h^3tM5 8) <o:^r^tc— i^LTV^S t 
4) <30Xf6:^iSj{a:e (XfiYffe^ipj^M) ^i;^-r-y>^ 

[0108] Xtti^^i^g6 2 (XfiY*&tt 

m^WLQA) coXt4:^iRl&g (Xfi:Y$fc^(pl{ig) «^ 
pgr6<7tc: itXI^trnz.) mt-r^oyx. xW^^^m (X 

xn^ij^mm (XiiY$ib;^f6]iMM) ;^>o</>tt©x«;^ 
/^feffx (XttYii:fer[6]{ftgy) B 1 UteJ^li i: 

J: o r ^i?> -5 C ;ds-C^ 5o 
(O 1 0 9 J ^/c. fi®lf29ij^am(r:^5v^r«. y ^ 

K.'^^tiirsS 8 ^m^^n^<^^^m.. xwitftage 2^: 

me 4^mmMm(7^miMi^wLt {^x^^mMmmi^M 
^n\i\ ^f>ixfcY*ih*-isi{iey ^lattu. xyz^m 
mm^\ci^n6^—yy hj^.itms b(om\^^ (x. 

Y, Z) ^lk^\C'^^xmm'r^o X = x Y=y 

Z=Y- t a n 0±5aiCi;f?. 3f;£*75ffma<^X Y 
Z*gM^^^t-:Jb^;t6J^g[it (X. Y, Z) ^i^*S»C 

[ o 1 1 o 1 ms ^mmm} mz^^m<D$^ 3 njfe?^ 

^^::ov^Tl^i^i-6o i^^*5v ^ i ^Bfe?f^^&u^^2llfi^ 

V K^gff iiijigg 8 2 fi. m2 mmnmxmm 

x«b;^7^— v?6 e^T/Ytt^T^-i^e sJcitxTXY;^ 
7^— e;^8 4:6Sf5:J:f e.i^xv^-5o 
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[01111012 (A) {ZTTk-r^^lc^ XY>^7^-v? 

6jlfc(J^^2i/r7 h 8 s^iii^Tv^^, tfli/ir:7h8 
6 <o^^W±. m 1 -vr :7 h 8 6 og^::^rB! t 

m2'>^:7 h8 8tiY|i&::^(pilc:^,^o 
[0 1 1 2] lai lJC;^'rJ: XY:^x~i^8 4 

Xtt:frr^JC?&ofc»l Vi':7^8 6^0ffijgSr^fetbi- 
5x4*{ill^^ffi^B74i:. :=^y'^y}i'iyy^-^^mW}m 
t U-C^2>'^:7 hS 8 $:Ytt:^iSl{C?JioT^i&^-^6 

8 <D^m^mi:i\±. mii^^y h8 G(OX^yjf^iCf^^ 

Ytt;^fpijc^aor:i^i(jtcj&i^ i^x^m-r^yi^- 1-90 
6 u—/i-Rx^m 2 :7 h 8 8 ^ 

fcwiaj 7 0 mm(om^i^^^^J^i^^fhtix^ 9 . 

^n^:Lt\zxr>. xy;?^7"— v?8 4tiS2p7ic^3a3 0 
[0 1 14] *rc. :*:m3^1fe?^ST-{i. ^ l 

■csiw ufcaifeSiSSft 4 0. 42. fH2 mmmmx*^m 

ufc^^^ge 2. 6 4|c:ft;tr. >^^^!^-^ffi^©9 2 

365^ttf>ttTv^6o j^^mj».mmm.9 2i^WLiMiUS2 

^-^-y hj^^ftms B(Dm^ (z*ft^;pig&«i) ^si 
mT^z^mm^mtf^9 A^^hmt^^tixi^^^ mm.^ 

mxxmm^thx\f^^. zmimmkkm^s 4 tvxnm 

^^(Dm^^^m-^t^xh^Ta*^. mx.umi2 (a) k:^7j^ 

[01 15] XY;^^'— v^8 4^U^:/U— h 9 0 

ti^^e^oliiRi^S (I^U<tifg^JS4Jc:|fitt(39jii^^ 

^) I=iM^£:L-C43 9. Xttfeig«femSP7 4 2fctJfYtt{4S 
t^tiiSC? 8ft;4i:^^to^2^ai^©f<::^f£^LTv^5o * 
fc, Z Wi«Efit^to^fli 9 4 lilS^K^ 4 f^ia^olB 3 it^td^ 

mzMf&\^x\^^^. 



(0 1161 mz^msmmmm(oi^m^m.m-t^. ^ 

a5$I5 7 4iri;oT^W^n'5X*fi:^rn]<4@. Y«i^3:M:B^ 

m^7 8\zx^xmm^^^Ym:^\^i5:m. Rv^zmm 

St«fem$l5 9 4 t:ij; o -Cftfetii $ Z ^;^fR]?&«i$r X Y Z 
<^i:T-. t3 4^ y hyNvK2 og^iOM^^^XYZffe 

(0 1171 *fc. {i^ffS'J^S{c::ib*v^TI±. ^-'^y 

YM^itm. 5 8 ^mm^woi^.%mi. %mmL 5 2 <sr^j«i 

5 2<^X*4;^fRl<ig5rX<i&;^rRlll^itjl«7 2tcJ;oT l^ 

2(OX$A:^f^{5^^d:SPg&<3(^ (tr/^mc) ^ 
^fc-r^^o^, X^:fe^f^<^ll755 0(04^||355^i;/j;d>o;t^ 
x«:frrRiill^255o<D<t#ox^:i^iRi&gx$rM 

(0 1181 j^v^r. m^(^^^2^^i^om'L>(5S<?>® 

^<D^*KA^mzn-r^ Ymj^\z.f^r>tcm^^iK^^zi 

h^. i^m^gs 2 0Ytt:^f^^g^Y^:frf5]^i?i$C7 

6 ic J; o T 1 ;^ 7^ 5/ J£ U ^j^ 0 3S 
i-o «^g5 2 0Y*lrJ^fRi&Kll®^6tj{c 

[0 119] ±l5Jc:J; 9. »§fe:*-|^;65i5'-y.> h;fe)tM 

lRiiSII;dio) Ufci:#<^x^ft:3^fRj^gx^c/Y#:^f^{i 
gy ('r/jri^-ibXYZ«63^fe«l^jc4oJt'5X)^aH&;5^t;t 

Ymmm i^t^n^ir^ic. mi 2 (a) tci^i-i:^ 

[0 12 0] ^fclC^-^^;. h.^)fet^5 8C0Z|*::^f^gg^ 

^:Z$ftgg«l«iailHS9 4t^j:ortfeHl'r6o H:^^JtfflT 
V;E7 ^ 7 9 4 a ^^A/T- Z M^m^Iii^ 9 4 «r«^ 

^m.\^x\^^^^mxz^-)i^mk (-r^j^h-^xYZi^ 

( o 1 2 1 1 1 2 (A) td.i^-ri: 7 3:^aiirfflT 
V>?7P< 7 9 4 A{iiilBC04feieT-^-y5^ h^^^taSS 8;5i 

wm^x^i^mmm 'xvii^v9A ajc j; -6mi^i: o 

"c^i=^bi^^^l^^^'^cl^^. iJ^-y^/ h^>tas^5 8|:l^JE£:i- 
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[0 12 21 ^<r>fz,^. «^;tl^H^»Jl:ffiTV*7« ^9 

4 A J: a J: o T# <b n ^ p5 

nmmm TV;«?>794A<cJ; J: o T# ^ ix^» 

iii^^jS^^^— h^%ms 8<oz**:*f6)«E8i$r*i?>^ 

nmrnmci^^-y ^mm^ (x. y, z) ^i^^i^ic:^^^) 

[O I 2 3] /^:J3. _hl5#fife(CioV^T. Si 2 (B) 

Hi^Ho;*?^ 7 9 4 A<o«fifcffiilffi2J^z#:J^[RHcfgoTi: 

10 12 41 ^fc. mt una 1 3ic.T^-rJ: z** 

U T I ^ -5 fti CO X W :^ 1^ © X ^ Y $6 :^ {4 g y 
^4?)fc^|:z. :^i?)rcXtt^l^&g:x^OfYtt:^lR]fii:gy 

io^ii[T(cfimi-6J;9ic^L — h 9 o^^ib^ii:. 

8t;i««-rSigT-A$r#S$-e:. ^-YvVi^itUs 
8 ic^ftfeLfc t tor- A<7){*«j?)-p> z*ft:^f^ggf^^ 

YZ»«-M^;^(c*5tt^M^1S (X, Y. Z) $rS«S 

loi 2 51 ^fc. «i|<bLT|gI14 (A) (ci^-rJ:^ 
tC. Z 9 4 f^jt l^-y^S 9 8 A/Xflf 

ii^u— y^S9 8<otS:^^S§9 8 A<7);9=-^2S:iSi-^»c 

VK2 8695fciiggI5(C^-y 5^ h,^im^ 82%.TJ«^^^ 7 

-9 6 ^^ftttSo ^<r>mmc^i'f^z^:^\^^<o^ 

^J^<OJ;9t-Xtt^lSjfir@x2lt;!Ytt;^fp](&gy 



iSui:Tt;:{4gi-^ J: ^ h 9 o Sr^ib$ii:fc4^ti 

(O 1 2 6l Ell 4 (B) lC^-rj:5l-. 3tt---i5^^® 

9 8«. ^tggi?!>^btt5:d^ix^-^^Scifc<oit-^ic:j:o 

3t^^^7t5?9 8 A7i^p5faii:;^fS]«c?&oTltm^ii:^ t 

m^KM^'^^o iS^3feS&9 8A75^e)Mm^i^fc>t^i/^ 
> K 2 8 05fe^^fC^f^ it «btvytS*t ^7-96 T^#t 

$tt. &^^§&9 8 AiCF^ia^ixTV^-5^^m3§t-J:o 
K2 8 0^SSSIfls<^z«i;^rpi®fil^^^mi-So ::ixtc 

M (X. Y. Z) $:i^fg«tc^«^'5C<b;6S-Ct6o 
(0 12 71 ±i2-CH:*:«^(c^6^l:^IU#@: 

x.\^^%^^w^<onm mxvim^ (a) i;i*5w>T. 
(0 12 81 i^_h. :^^m<Dm^mm\^^\^xmm\^tc 

(0 12 91 (1) PJJ^^' h^^^- KO«fl!l^lfe^rBlOi£ 

lc^S^fL«.::i:^#m^t-^ft^^iiaife<on7K2/ b 
(0 13 01 (2) :^{4^&tI«ffiJ:^$r^^jE^ti-e. nj}? 

#^t^a:ii-5^2^m^si:, ^m\^^W(.(D^]^^}^t^ 
i^tb^^jc J: o r $ i:\.iL-^m^Rx:^mn jcs^v ^ 

(0 13 11 
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(B) nmf^mw<o-i?^i:7^'rMmxh^. 
i^(Dm*t^m(omit(D-m^^^'t4 j^-i^m. (b) «j 



umnkmm.. Ymmtkmm^^^Tji-rm^m. (b) t± 
iay^S(7)MR&ifi^S::T^-r :/ D y -e A> -5. 

[iai2l (A) RXji (B) liH^aiJSffiTV;&>7 

mi 4} (A) fi^tu— y^^Ay-eztemsitiiai^ 

to asK-/ hyN>' K&®Ifilli^e 

1 2 mm^ 

2 O a4f^^ b/N^/ K 
4 0 ^1 co^^Miti^ 

4 2 m2<ommmmm 

5 2 

6 4 Y^^^^g 

5 8 ^-y^y hj^^a§[ 

6 0 13 7}^-/ hyN>' msifia'ji^® 

6 2 X^^^S 
6 4 Y4Atl^ia^@ 

8 2 njjf^y hyA>^ mati-iii^g 

9 2 ^^^:^aj^@ 

9 4 zf^mm^map 
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